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Bearing-Based Distributed Control and Estimation of Multi-Agent Systems 

Shiyu Zhao and Daniel Zelazo 


Abstract —This paper studies the distributed control and 
estimation of multi-agent systems based on bearing information. 
In particular, we consider two problems: (i) the distributed 
control of bearing-constrained formations using relative po¬ 
sition measurements and (ii) the distributed localization of 
sensor networks using bearing measurements. Both of the two 
problems are considered in arbitrary dimensional spaces. The 
analyses of the two problems rely on the recently developed 
bearing rigidity theory. We show that the two problems have the 
same mathematical formulation and can be solved by identical 
protocols. The proposed controller and estimator can globally 
solve the two problems without ambiguity. The results are 
supported with illustrative simulations. 

I. Introduction 

In recent years, distance rigidity theory has played an 
important role in the area of distributed control and esti¬ 
mation of multi-agent systems. For example, it has been 
widely applied in distance-based formation control [ 1 ]—[4] 
and distance-based network localization [5], [6], The global 
distance rigidity can ensure the unique shape of a framework, 
but it is very difficult to examine mathematically. Many of 
the existing works adopted the assumption on infinitesimal 
distance rigidity which can be easily examined by a rank 
condition [1]—[4]. Infinitesimal distance rigidity is, however, 
not able to ensure a unique shape, which may result in 
undesired control or estimation solutions. Additionally, due 
to a large number of undesired equilibriums in distance- 
based formation control, the gradient control law can only 
be proved to be locally stable for general formations [1]—[4]. 

As with distances, bearings can also be used to character¬ 
ize the shape of a network. In recent years, there has been 
a growing interest in bearing rigidity theory (also known as 
parallel rigidity theory) [7]—[10] and bearing-based control 
and estimation problems including bearing-based formation 
control [9]—[ 13] and bearing-based network localization [14], 
[15]. Most of the previous studies on bearing rigidity only 
focused on frameworks in two-dimensional ambient spaces 
[7]—[10]. In our recent work [16], we extended the previous 
studies and established the theory of bearing rigidity in 
arbitrary dimensions. We showed that bearing rigidity has 
a number of attractive features compared to distance rigid¬ 
ity. For example, infinitesimal bearing rigidity can globally 
determine the unique shape of a framework, and it can 
also be conveniently examined by a rank condition of the 
bearing rigidity matrix. The bearing rigidity theory has been 
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successfully applied to solve bearing-only formation control 
problems in [16]. 

In this paper, we apply bearing rigidity theory to solve 
two problems: (i) distributed control of bearing-constrained 
formations using relative position measurements and (ii) dis¬ 
tributed localization of sensor networks using bearing mea¬ 
surements. Both of the problems are considered in arbitrary 
dimensions. The problem formulations of the two problems 
actually are the same and hence the two problems can be 
solved by identical protocols. The proposed linear controllers 
and estimators can globally solve the two problems without 
ambiguity. 

Notations: Given A, t £ R px9 for i = 1denote 
diag(Aj) = blkcliag{A 1 ,...,A„} e R npX11q . Let Null(-) 
and Range(-) be the null space and range space of a matrix, 
respectively. Denote Id £ R dxd as the identity matrix, and 
1 = [1,..., 1] T . Let || • || be the Euclidian norm of a vector 
or the spectral norm of a matrix, and ® be the Kronecker 
product. An undirected graph, denoted as Q = (V,£), 
consists of a vertex set V and an edge set £ C V x V. 
Let n = |V| and m = |£|. The set of neighbors of vertex i 
is denoted as A) = {j £ V : (i,j) £ £}. An orientation of 
an undirected graph is the assignment of a direction to each 
edge. An oriented graph is an undirected graph together with 
an orientation. The incidence matrix of an oriented graph is 
denoted as H £ R rn x n . For a connected graph, one always 
has H 1 = 0 and rank(Lf) = n — 1. 

II. Preliminaries to Bearing Rigidity Theory 

Bearing rigidity theory will play a key role in the analysis 
of bearing-based distributed control and estimation problems. 
In this section, we revisit a number of important notions and 
conclusions in bearing rigidity theory [16]. 

We first introduce a particularly important orthogonal 
projection matrix operator. For any nonzero vector x £ 

(d > 2), define the operator P : R d —» R dxd as 



For notational simplicity, we denote P x = P(x). Note that 
P x is an orthogonal projection matrix that geometrically 
projects any vector onto the orthogonal compliment of x. 
It is easily verified that 1’J = P x , P x = P x , and P x is 
positive semi-definite. Moreover, Null(P x ) = spanjx} and 
P x has one zero eigenvalue and d — 1 eigenvalues as 1. 

Given a finite collection of n points {p,:}” =1 in R d (n > 2, 
cZ > 2), a configuration is denoted as p = [pj,... ,Pn] T £ 
R d ". A framework in R d , denoted as Q(p), is an undirected 
graph Q = (V, £) together with a configuration p , where 



vertex i G V in the graph is mapped to to the point p, in the 
configuration. For a framework Q(p), define the edge vector 
and the bearing, respectively, as 

t'ij Pj Pij 3ij e-ij /11 Ly 11' I (i i j ) C £ • 

The bearing g t j is a unit vector. Note e,y = —e 7 j and 
Qij = ~9ji- It I s often helpful to consider an oriented 
graph and express the edge vector and the bearing for the 
fcth directed edge of the oriented graph as e k = p t — p B 
gk = e k /\\e k \\, Vfc G {1, • • ■, m}. Let e = [ef,„.,e^] T 
and g = [gj, ..., c/JJ T . Note e satisfies e = Hp where 
II = II 0 I,/ and H is the incidence matrix. Define the 
bearing function F B : R dra —> as 

F B (p)±[g T,...,gZF. 

The bearing function describes all the bearings in the frame¬ 
work. The bearing rigidity matrix is defined as the Jacobian 
of the bearing function, 

R B (p) = e R dmxdn . (1) 

Two important properties of the bearing rigidity matrix are 
given as below. 

Lemma 1 ([16]). The bearing rigidity matrix in (1) can be 
expressed as R B (p) = diag (-Fg fc /||efc||) H. 

Lemma 2 ([16]). For any framework G(p), the bearing 
rigidity matrix satisfies rank)/?#) < dn — d — 1 and 
spanl (g) Id,p C Null)/?#)- 

Let Sp be a variation of p. If R B {p)5p = 0, then Sp is 
called an infinitesimal bearing motion of Q(p). A motion is 
an infinitesimal bearing motion if and only if the motion 
preserves the bearing between any pair of neighbors in the 
framework. An arbitrary framework always has two kinds of 
trivial infinitesimal bearing motions: translation and scaling 
of the entire framework. We next define one of the most 
important concepts in bearing rigidity theory. 

Definition 1 (Infinitesimal Bearing Rigidity). A framework 
is infinitesimally bearing rigid if the infinitesimal bearing 
motions of the framework are trivial. 

The following is a necessary and sufficient condition for 
infinitesimal bearing rigidity. 

Theorem 1 ([16]). For any framework Q ( p), the following 
statements are equivalent: 

(a) Q(p) is infinitesimally bearing rigid; 

(b) rank)/?#) = dn — d— 1; 

(c) Null)/?#) = span{l (g> 7 d ,p}. 

Theorem 2 ([16]). An infinitesimally bearing rigid frame¬ 
work can be uniquely determined by the inter-neighbor 
bearings up to a translation and a scaling factor. 

As will be shown later, infinitesimal bearing rigidity plays 
an important role in bearing-only network localization. 


III. Problem Formulation 

In this section, we present the formulations of the two 
problems of bearing-based formation control and bearing- 
based network localization, and then propose linear con¬ 
trollers and estimators to solve them. 

Consider a network of n agents in R. d (?i > 2, d > 2). 
The network may represent a multi-vehicle system or a 
sensor network. Denote p t G R' ( as the position of agent 
i G {l,...,n}, and let p = [pj,..., p^] T G R dn . The 
interaction graph Q = (V. £) is assumed to be connected, 
undirected, and fixed. The network is denoted as Qip). 

A. Bearing-Based Formation Control 

In this subsection, we study the problem of bearing-based 
formation control, the aim of which is to stabilize a target 
formation with bearing constraints using relative position 
measurements. Specifically, the target formation is specified 
by the constant bearing constraints {.<? ij}(i,j)e£ where gf = 
— g*i . The bearing constraints must be feasible such that 
there exist formations satisfying the constraints. Suppose 
agent i can measure the relative positions of its neighbors, 
{pi — PjjjeJTf The dynamics of agent i are assumed to 
be a single integrator Pi(t) = ufit), where ufit) G 
is the input to be designed. The problem of bearing-based 
formation control is stated as below. 

Problem 1 (Bearing-Based Formation Control). Given fea¬ 
sible constant bearing constraints {g*j}(i,j)e£ an d an initial 
position p(0), design u t (t) (i G V) based on the relative posi¬ 
tion measurements {pi(t)—pj(t)}j^sf i such that gij(t) —> gT 
as t —> 00 for all ( i,j ) G £. 

We next propose two controllers to solve Problem 1. The 
first controller is leaderless, and the second one assumes 
fixed leaders in the formation. 

1) Leaderless Case: The leaderless formation controller 
is designed as 

Pi(t) = - P 9h - Pj (*))> * e ( 2 ) 

jeRi 

where P 9 *. = Id — 9*j{9ij) T ■ The matrix expression of 
controller (2) is 

p(t) = -C(g,g*)p(t)i (3) 

where £(Q,g*) G m dnxdn is a matrix-weighted Laplacian. 
In particular, let \C(G, g*)\ij be the ij th block of size dx d 
in C{Q,g*), then 

[£{G,9*)\ii = -Pgf, 

[C{g,g*)}u=Y, P 9tp W 

jeRi 

When the context is clear, we simply write £(Q,g*) as C. 

2) Leader-Follower Case: As will be shown later, con¬ 
troller (3) can successfully solve Problem 1 but cannot the 
centroid or the scale of the formation. Motivated by this, 
we introduce fixed leaders and propose a leader-follower 
controller. Suppose there are ni (0 < rii < n) fixed agents 



which are called leaders. The rest (n — rii) agents are called 
followers. Denote V; and V/ as the index sets for the leaders 
and followers, respectively. Note V;UV/ = V, V; = m , and 
|V/| = n — ni. When ?%i = 0, it will be the same as the above 
leaderless case. The leader-follower formation controller is 
designed as 


Pi(t) = o , ieVi, 

Pi(t) = ~Y1 P 9h (ftW - Pi(0). *eV/. (5) 

feWs 

Assume without loss of generality that the first rq agents 

are leaders and the rest are followers. As a result, V/ = 

{1, and Vf = {ni + 1 ,...,n}. Denote pi = 

\Pi,---,Pn l ] T e R dni and p f = [p£ +1 ,... ,p^] T G 
jgd(n-m) p ar titi on £ i n t G the following form 


£ = 


Az 


A/ 

£ // J 


where C u G R dn,x<in! , £ lf = G Rd«ixd(n-n,) ) and 
Cff G K d ("- n i) xd («-"i). Then, the matrix expression of 
controller (5) is 


It is notable that the above estimator has the same formula 
as the controller (5). Define C{Q,g) G K dnxdn with 


[•£(f5i 9)\ij — Pgiji J 

ms,9)]u= E (8) 

feW; 


When the context is clear, we simply write C(Q,g) as C. 
Without loss of generality, assume the first n a agents are 
anchors and the others are followers. As a result, V 0 = 
{1,..., n a } and V/ = {n a + 1,..., n}. Denote p a = 

IPl’-'-’PnJ 1 e Rdna and Pf = [Pn 0 +l»-‘-»Pn] T £ 

partition C into the following form 


C = 


Caa 

C'fa 


P-af 

Pff 


where C aa G R*»axdn 0) £ af = C] a G Rdn a xd(n-n a ) ^ and 

Cff & yi d ( n - n a) xd (n-na.)' Then, it is straightforward to see 
the matrix expression of controller (7) is 


Pa(t) = 0, 

Pf(t) = -PffPfW - Cf a p a , (9) 


Piit) = 0, 

Pf(t) = —Cffp f (t) - Cfipi, (6) 

where pi is constant since the leaders are stationary. 

B. Bearing-Based Network Localization 

In this subsection, we consider the problem of bearing- 
based network localization, the aim of which is to estimate 
the positions of the agents in a network merely using bearing 
measurements. Agent i maintains an estimate p, of its own 
fixed position p,. Agent i can measure the bearings of its 
neighbors, {fJijjjeNn and can a l so obtain the estimates of 
its neighbors (via communication), {pjjje.V, ■ The estimation 
update law for agent i has the form of Pi(t) = where 

u l (t) G is the input to be designed. The bearing-based 
network localization problem is stated as below. 

Problem 2 (Bearing-Based Network Localization). Suppose 
p is constant. Given an initial estimate p{ 0), design Ui(t) 
(i G V) based on the relative estimates {pi{t) — Pj{t)}j<zNi 
and the constant bearing measurements {jfijjjeN, such that 
Pi(t) —> Pi as t —> oo for all i G V. 

Suppose a subset of the agents, known as anchors, can 
measure their own real positions; the remaining agents are 
called followers. We do not consider the anchorless case here 
because the network cannot be localized without anchors. 
Suppose there are n a (0 < n a < n) anchors and n — n a 
followers. Denote V a and V/ as the index sets for the anchors 
and followers, respectively. Then V a U V/ = V, |V 0 | = n a , 
and |V/| = n—n a . The anchor-follower estimator is designed 
as 

Pi(t) = 0, i G V a , 

Pi(t ) = - P 9ij (PiW - &(*))> * e v f- ( ? ) 

jeNi 


where p a is constant and known. 

IV. Convergence Analysis 

In this section, we analyze the convergence of the pro¬ 
posed controllers and estimators. Since the network local¬ 
ization has the same form as the formation control, we will 
mainly focus on the convergence analysis of the formation 
control and the convergence results for the network localiza¬ 
tion are given without proofs. 

A. Convergence Analysis of Formation Control 

In order to prove the convergence of the proposed con¬ 
trollers, we adopt the following assumption. 

Assumption 1. Any formation G(p*) that satisfies the bear¬ 
ing constraints {g*j}(i,j)e£ * s infinitesimally bearing rigid. 

Assumption 1 gives two useful conditions. By Theorem 2, 
the first condition is that the target formation specified 
by the bearing constraints has a unique shape. By Theo¬ 
rem 1, the second condition is a mathematical condition 
that rank(i? B (p*)) = dn — d — 1 and Null (Rb{p*)) = 
spanjl ® Id,P*} where R B {p*) = diag (P g -/\\e* k \\) H is 
the bearing rigidity matrix. Since the distance term ||e£|| in 
Rb{p*) does not affect its rank or null space, the condition 
given by Assumption 1 actually is 

Null (diag (P g *) H) = span{l (g> I d ,p*}- 

This condition will be crucial to the following convergence 
analysis. 

1) Leaderless Case: We first consider the case without 
leaders and study the formation dynamics (6). Since the 
system (6) is linear and time-invariant, its convergence is 
totally determined by the spectrum of C. The next result 
characterizes the rank and null space of C. 



Lemma 3. Under Assumption 1, the C defined in (4) 
is symmetric positive semi-definite. Moreover, it satisfies 
rank(£) = dn — d — 1 and 

Null(jC) = spanjl ® I d ,P*}, 

where p* is an arbitrary configuration satisfying {gf }(,;.,)££• 

Proof. Since the graph is undirected, C can be written 
as C = H t diag(P g *) H , which is clearly symmetric and 
positive semi-definite. Moreover, due to P g * = Pj*P g *, C 
can be rewritten as 

C = f/ T diag(P ^) diag(P g Jg . 

kl Rb 

By Assumption 1, we have rank(i?s) = dn — d — 1 and 
Null(i?s) = span{l ® I d ,p*}. Since £ has the same rank 
and null space as Rb, the proof is complete. □ 


Based on Lemma 3, we can analyze the convergence of 
system (3). Since £ is symmetric, its left and right null 
spaces are the same. Although {1 <g> I d ,P*} is a basis of 
Null(£) by Lemma 3, it is not an orthogonal basis in 
general. In order to obtain an orthogonal basis, we first define 
th e formation centroid (denoted c(p)), normalized formation 
(denoted r{pj), and formation scale (denoted s(p )) as 

c(p) = 1 ^, r(p) =p-10c(p), .s(p) = ||r(p)||. 

Note r{p) is always orthogonal to 1 ® Id- As a result, if 
denoting r* = p* — 1 0 c(p*), we have {1 0 Id,r*} is an 
orthogonal basis of Null(£). When the context is clear, we 
will simply write c(p),r(p),s(p) as c, r, s. 


Theorem 3 (Convergence of Leaderless Control). Under 
Assumption 1, the trajectory of system (3) converges expo¬ 
nentially from any initial point p(ff) to 

pM = i®»(o) + (LLp ( o)) 

If (r*) T p(0) > 0, the leaderless controller (2) successfully 
solves Problem 1. Furthermore, the centroid and the scale 
of the final formation are c(oo) = c(0) and s(oo) = 
|(r*) T p(0)/||r*|| |, respectively. 

Proof. Denote A = [1 0 Id,r*] G R dnx ( d +i) ^ gy the linear 
system theory, the trajectory p(t) of system (3) converges to 
the orthogonal projection of p(0) onto Range(A): 


p( oo) = A(A t A) 1 A T p(0) 

= (l®/ d ) ((l0/ d ) T (l0 J d )) 
r*(r*) T 


-1 


(1 0/ d ) T p(O) 


(r*) 1 


rf°) 


= 10 c(0) + 


(r*) T p(0) r* 

IMl FT 


It is easy to verify that the centroid and the scale of the final 
formation are c(oo) = c(0) and s( oo) = I(r*) T p(0)/||r*||I, 
respectively. The final formation p( oo) can be obtained 



Fig. 1: The simplest example to demonstrate the geometric interpretation of 
the leaderless controller (2). Initial formation: gray; target/final formation: 
blue; agent trajectory: dotted line. 


by translating and scaling r*. Since G(r*) satisfies all the 
bearing constraints, G{p( oo)) also satisfies as long as the 
scaling factor (f*) T p(0)/||?’*|j is positive. □ 

Several remarks regarding Theorem 3 are given here. 

(a) When (r*) T p(0) < 0, the formation converges to a final 

formation with the bearings as g ig = G 8 

instead of fjij = g*j,V(i,j) € 8- In this case, although 
the final formation has the opposite bearings as desired, it 
can be viewed as a point reflection of the target formation 
and has the same shape. 

(b) The centroid of the final formation is the same as that of 
the initial formation. In fact, it follows from ( l0l d ) T p = 
0 that the centroid of the formation is invariant under 
controller (2). 

(c) Although the centroid is invariant, the scale of the 
formation is changed under controller (2). Specifically, 
the scale of the final formation satisfies 

0 < s(oo) < s(0). 

The scale of the final formation is no larger than that of 
the initial formation. It is clear that the lower bound of 
s(oo) is achieved when (r*) T p(0) = 0. In this case, the 
formation will finally reach rendezvous (i.e., consensus 
in terms of position). In order to obtain the upper bound, 
rewrite (r*) T p(0) = (r*) T (p(0) — 10 c(p( 0))) = 
(r*) T r(0). Then s(oo) = |(f*) T ?"(0)/||r*||| < ||r , (0)|| = 
s(0). As a result, the upper bound of s(oo) is achieved 
when r* is parallel to p(0) or r(0). 

Fig. 1 shows the simplest example to demonstrate con¬ 
troller (2). In this example, the target formation is vertical. 
The final position of each agent is the orthogonal projec¬ 
tion of its initial position to the target bearing. Moreover, 
the centroid of the formation is invariant but the scale is 
changed. It is intuitively obvious that if the initial formation 
is horizontal, the two agents will reach rendezvous. 

2) Leader-Follower Case: Although the controller (2) 
is able to solve Problem 1, the centroid and the scale 
of the finally converged formation are determined by the 
initial formation, which is usually undesired in practice. We 
next show that the centroid and the scale of the formation 
can be controlled by the leader-follower controller (5). We 
first analyze the properties of Cff in the leader-follower 
controller. 













Lemma 4. Under Assumption 1, Cff in system (5) is positive 
definite if and only if m > 2 . 


Proof. For any x € R dni , since C > 0, we have 


x T CffX = 0 a; T 


r £is 


' 0 ' 

_i 


X 


> 0. 


As a result, Cff is at least positive semi-definite. If there 
exists a nonzero vector x such that x T LffX = 0, then 
[0,x T ] T e Null(£) = spanjl 0 I d ,r*}. If there is only 
one leader (m = 1), it is easy to see that such x exists. 
However, if there are more than one leaders (m > 2), such 
x does not exist because p., ^ pj for all i ^ j. Thus, in the 
case of m > 2, L ff is positive definite. □ 


When ri[ > 2, the positions of the leaders, pi, must be 
feasible such that the followers together with the leaders can 
possibly form a formation satisfying the bearing constraints. 
The following is a necessary condition for a feasible pi. 


B. Convergence Analysis of Network Localization 

We adopt the following assumption to analyze the conver¬ 
gence of system (9). 

Assumption 2. The network G(p) is infinitesimally bearing 
rigid. 

The properties of C defined in (8) are given below. 

Lemma 6. Under Assumption 2, the C defined in ( 8 ) 
is symmetric positive semi-definite. Moreover, it satisfies 
rank(£) — dn — d — 1 and 

Null(£) = span{l 0 Id,p}- 

Proof. Similar to Lemma 3. □ 

Lemma 7. Under Assumption 2, Cff in system (9) is positive 
definite if and only if n a > 2 . 

Proof. Similar to Lemma 4. □ 


Lemma 5. Under Assumption 1, a feasible pi satisfies 
(Cu ~ CifCfjCfi ^ pi = 0 . 

Proof. If pi is feasible, there exists pf such that p = 
{pJ,pJ] T satisfies the bearing constraints {g*j}(i,j)e£- By 
Theorem 2, infinitesimal bearing rigidity can uniquely deter¬ 
mine p up to a translation and a scaling factor. That means 
p £ spanjl 0 Id,r*} = Null(£) and consequently 


Cu Cif 


pi 

. c p £fs _ 


. PS . 


which implies Cupi + CifPf = 0 and Cfipi + CffPf = 0. 
The second equation implies pf = —CjfCfipi, substituting 
which into the first equation completes the proof. □ 

Based on Lemmas 4 and 5, we have the following con¬ 
vergence result for the leader-follower formation controller. 

Theorem 4 (Convergence of Leader-Follower Control). Un¬ 
der Assumption 1, given ni > 2 and a feasible pi, the 
trajectory of system (6) converges exponentially fast from 
any initial p/(0) to 

Pf(oo) = -C~) C n pi. 


By the above two lemmas, the positions of the anchors 
and followers satisfy the following condition. 

Lemma 8. Under Assumption 2, if n a > 2, then p a and pf 
satisfy 

Pf = C j j, Cf a p a . 

Proof. Since Null(£) = span{l 0 Id,p} by Lemma 6, we 
have 


^aa ^af 


Pa 

. £ff „ 


. Pf . 


which implies Cf a p a +CffPf = 0. Since Cff is nonsingular 
given n a >2 , pf can be solved as Pf = —CjjCf a p a ■ □ 

The next is the main convergence result of the anchor- 
based estimator (7). 

Theorem 5 (Convergence of Anchor-based Localization). 
Under Assumption 2, if n a > 2, the trajectory of system (9) 
converges exponentially fast from any initial estimate fif( 0) 
to 

Pf(°°) = -£~f)£faPa = Pf- 

AS a result, the estimator (7) successfully solves Problem 2. 


The finally converged formation satisfies the bearing con¬ 
straints {g*j}(i,j)e£- 

Proof. Since Cff > 0 if ni > 2 by Lemma 4, it is 
obvious that the linear time-invariant system (6) is exponen¬ 
tially stable. Then the final formation (i.e., the equilibrium) 
satisfying pf = 0 is p/(oo) = —CjjCfipi. Since pi is 
feasible, it follows from Lemma 5 that Cp{ oo) = 0 where 
p( oo ) = [pfjpJ (oo)] t . Therefore, G(p( oo)) satisfies the 
bearing constraints. □ 

As shown in Theorem 4, the final formation Pf(oo) is a 
function of pi. As a result, we can control the centroid and 
the scale of the final formation p(o o) by choosing appropriate 
positions of the leaders pi. 


Proof. Since Cff > 0 if n a > 2, it is obvious that the 
linear time-invariant system (9) is exponentially stable. The 
the final estimate (i.e., the equilibrium) that satisfies Pf = 0 
is given by p f ( oo) = - CjfC fa p a . Since p f = -CfjCf a p a 
according to Lemma 8, we know fif(oo) = pf. □ 

V. Simulation Examples 
A. Examples for Bearing-Based Formation Control 

We now show two examples in Figs. 2 and 3 to verify 
the leaderless and leader-follower controllers (2) and (5), 
respectively. The target formation for the two examples 
is a three-dimensional cube with 8 agents and 13 edges. 
The target formation is infinitesimally bearing rigid because 
rank(f?s) = 20 = 3n — 4 according to Theorem 1. The 




(a) Initial formation 



(b) Final formation 



(a) Real network (b) Initial localiza-(c) Final localiza-(d) Localization 
tion tion error 


Fig. 2: A 3D example for bearing-based formation control: leaderless case. Fi §- 4: An example for bearing-based network localization. Green dots: 

estimates; red dots: anchors. 




(a) Initial formation (b) Final formation 

Fig. 3: A 3D example for bearing-based formation control: leader-follower 
case. Agents in red are fixed leaders. 


initial formations are randomly generated. There are no 
leaders in the example in Fig. 2, while there are two fixed 
leaders in Fig. 3. As can be seen, the target formation 
can be achieved in both of the two examples. But the 
centroid and scale of the final formations are different. In 
the leader-follower case, the centroid and the scale of the 
final formation are determined by the two fixed leaders. 

B. Examples for Bearing-Based Network Localization 

We next present examples to verify the anchor-based 
network localization estimator (7). Fig. 4(a) shows a three- 
dimensional network with 50 agents, 269 edges, and 4 fixed 
anchors. The network is infinitesimally bearing rigid because 
rank(jR^) = 146 = 3n — 4. The initial estimate shown in in 
Fig. 4(b) is randomly chosen. As can be seen in Fig. 4(c)-(d), 
the estimate errors \\pi(t) — Pi\\ finally converge to zero. 

VI. Conclusions 

In this paper, we applied bearing rigidity theory to solve 
two bearing-based control and estimation problems in ar¬ 
bitrary dimensional spaces. The proposed linear controllers 
and estimators can globally solve the two problems without 
ambiguity, respectively. This paper only considered the cases 
of undirected and fixed underlying graphs. One may study 
the cases of directed and switching graphs in the future. 
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